/*============================================================================*/
/*                         The Freescale Cup                                 */
/*============================================================================*/
/*                        OBJECT SPECIFICATION                                */
/*============================================================================*
* %name:            %	APPLeds.c
* %version:         %	1.0
* %created_by:      %   Continental
* %date_created:    %   Sun Aug 21 16:20:00 2011 
*=============================================================================*/
/* DESCRIPTION : Contains applications that use the TRK-MPC5604B LEDS         */
/*============================================================================*/
/* FUNCTION COMMENT : comment here										      */
/*                                                                            */
/*                                                                            */
/*============================================================================*/
/*                               OBJECT HISTORY                               */
/*============================================================================*/
/*  REVISION |   DATE      |                               |      AUTHOR      */
/*----------------------------------------------------------------------------*/
/*  1.0      | 21/08/2011  |                               | Continental     */
/* Application using LEDS to show the scheduler working                       */
/*============================================================================*/

/* Includes */
/* -------- */
#include "stdtypedef.h"
#include "HALLservo.h"
#include "APPservo.h"
#include "MAL_pit.h"
#include "MALbeMIOS.h"

/* Functions macros, constants, types and datas         */
/* ---------------------------------------------------- */
/* Functions macros */

/*==================================================*/ 
/* Definition of constants                          */
/*==================================================*/ 


/*======================================================*/ 
/* Definition of RAM variables                          */
/*======================================================*/ 


/*======================================================*/ 
/* close variable declaration sections                  */
/*======================================================*/ 

/* Private defines */

/* Private functions prototypes */
/* ---------------------------- */

/* Exported functions prototypes */
/* ----------------------------- */


/**************************************************************
*  Name                 : Led1_init
*  Description          : Prepare Led1 application.
						  This function initialize Led1_app 
*  Parameters           :  none
*  Return               :  none
*  Critical/explanation :  No
**************************************************************/
void APPwheel_direction_init(void)
{
	HALLwheel_init_hardware();

}


/**************************************************************
*  Name                 : Servo_app
*  Description          : Toggle Led2. 
*  Parameters           :  none
*  Return               :  none
*  Critical/explanation :  No
**************************************************************/
void APPservo_app(void)
{
	if(!S1)
  	{
       
  	  	EMIOS_0.CH[1].CADR.R	  = TURN_LEFT_RA;        
  		
  		
  	}
  	else if(!S2)
  	{
  	  
  	  	EMIOS_0.CH[1].CADR.R	  = INITIAL_POSITION_RA;
  	  	  	
  	}
  		
  	else if(!S3)
  	{
  	  
  	  	EMIOS_0.CH[1].CADR.R	  = TURN_RIGHT_RA;	  	
  	  	
  	}
  	
  	else
  	{
  		
  		EMIOS_0.CH[1].CADR.R	  = 	EMIOS_0.CH[1].CADR.R;	
  	}
  
}
